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Abstract 

This paper presents a Cartesian-space position/force controller for redundant robots. The proposed control structure 
partitions the control problem into a nonredundant position/force trajectory tracldng problem and a redundant mapping 
problem between Cartesian control input F £ IF' and robot actuator torque T £ R (for redundant robots, 771 < nl The 
underdetermined nature of the F -*■ T map is exploited so that the robot redundancy is utilized to improve the dynamic 
response of the robot. This dynamically optimal F — T map is implemented locally (in time) so that it " £ 
efficient for on-line control; however, it is shown that the map possesses globally optimal characteristics. Additionally, i 
demonstrated that the dynamically optimal F -* T map can be modified so that the robot redundancy is used to simultaneously 
improve the dynamic response and realize any specified kinematic performance objective _(e.g. manipulabihty maxinuzation 
or obstacle avoidance). Computer simulation results are given for a four degree of freedom planar redundant robot under 
Cartesian control, and demonstrate that posit ion/ force trajectory tracking and effective redundancy utilization can be achieved 
simultaneously with the proposed controller. 

It is predicted that in the near future robot manipulators will be required to perform complex tasks that demand great 
dexterity and versatility in both position control and force control applications. Such tasks will require performance superio 
to that obtainable with conventional six degree of freedom (DOF) robots under the control of joint-space position servo loops^ 
This fact has motivated increased research activity in the area of redundant robot manipulators. Redundant robots possesses 
more DOF than are necessary to achieve the desired position and orientation of the end-effector, and it is expected th 
“extra” degrees of freedom can be used to improve the robot’s performance. 

Most of the research on the control of redundant robots reported to date has focused on the inverse kinematics problem, 
which involves the calculation of the joint-space trajectory that provides the desired end-effector motion and in addition 
satisfies some side criterion. The majority of this work has involved using redundancy to realize some kinemattc perform^ice 
objective. A partial fist of kinematic performance criteria that have been studied includes singularity avoidance [1,2], obstacle 
avoidance [3,4], joint limit avoidance [5,6], repetitive motion conservation [6,7], and achievable accuracy [8]. Research m lu 
manipulator redundancy is utilized to achieve a dynamic performance objective has been more limited, and includes studies 
of minimizing joint torque requirements [9,10], minimizing manipulator energy consumption [11,12], and increasing the robot 

dynamic response [13,14]. . , . H q1 

It has only been very recently that researchers have considered the complete redundant robot control problem [14- J. 
The controllers described in [14-16] are model-based control schemes which require complete knowledge and calculation of the 
complex robot dynamic model. In addition, each of these control algorithms requires either exphcit or implicit calculation of the 
inverse kinematics of the robot. Alternatively, the control strategy presented in [17-19] is an adaptive Cartesian-space control 
algorithm which does not require calculation of either the robot dynamic model or the inverse kinematics, and which has been 
shown through simulations and experiments to perform well. However, this controller has thusfar been applied only to control 
problems in which the redundancy is utilized to realize kinematic performance objectives. 

This paper presents an adaptive Cartesian position/force controller for redundant robots. The proposed control strategy is 
to partition the control problem into a nonredundant trajectory tracking problem and a redundant mapping problem between 
Cartesian control input F £ R m and robot actuator torque T £ R (for redundant robots, 771 < I n). The underdetermmed 
nature of the F —+ T map is exploited to allow the redundancy to be effectively utilized directly in Cartesian-space. Computer 
simulation results are given for a four DOF planar redundant robot under the control of the proposed algorithm, and demonstrate 
that accurate position/force trajectory tracking and effective utilization of redundancy can be achieved simultaneously with the 

controller. , , . , 

The paper is organized as follows. In Section 2, the redundant robot position/force control problem is formulated in the 
partitioned form indicated above. The F —* T map which uses the robot redundancy to increase the robot’s dynamic response 
is constructed in Section 3. This dynamically optimal F —* T map is modified in Section 4 so that the robot redundancy 
can be used to simultaneously improve the dynamic response and realize any specified kinematic performance objective, the 
performance of the controller is illustrated in Section 5 through a computer simulation study. Section 6 summarizes the paper 
and draws some conclusions. 

2. PROBLEM FORMULATION 


2.1 Basic Theory . . T u 

Consider an 71 DOF robot manipulator performing tasks in an 771-dimensional Cartesian-space (with 771 < 71). Ihese 
tasks will, in general, involve motion of the robot end-effector in certain directions and exertion of force by the end-effector on 
the environment in the remaining directions. The particular directions of motion and force exertion depend on the nature of 
the task. Consider now a task-related “constraint frame” which is defined by the particular end-effector/environment contact 
situation [20], In the constraint frame, the 771-dimensional Cartesian-space can be decomposed into an /-dimensional position 
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orth^T 1 “™“ ' , '^ nenS, °? subspice , where / + J = m and where the position subspace and force subspace are 

orthogonal The position subspace contains the / directions in which the robot end-effector is free to move and along which 
the end-effector position is to be controlled, while the force subspace contains the j directions in which the robot end-effector 
.constrained by the environment and along which the contact force is to be controlled. For convenience it will be assumed in 
the following that all quantities are expressed in terms of the constraint frame unless otherwise noted 

Let y e /< define the position (and orientation) of the end-effector in Cartesian-space and 0 E R n be the vector of joint 
coordinates. The relationship between end-effector position y and joint-space position 9 is 

3 / = /(*) ( 1 ) 

y=J{9)6 ( 2 ) 

where / : R n — R m represents the forward kinematics of the robot and J = df/d0 £ R mxn is the end-effector Jacobian 
matrix. ^It may be assumed without loss of generality that the elements of y are ordered such that y = [x T | z T ] T , where 

6 "'1 th ' end ' effector i (“d orientation) vector, in the position subspace and force subspace, 

respectively. Given this partitioning for y, the following partitioning for J may be defined: 


9 


where J p £ R ,xn and Jj £ R 3 xn are termed the “position subspace Jacobian” and “force subspace Jacobian", respectively 
2 jj* dyn<muc modeI of the robot Wlth «t» end-effector in contact with the environment may be written in joint-space as [e.g., 

T=H (9)9 + V ec (9 , 9) + V f (0, 9) + G(9) + jJ(9)P (3a) 

where T € R n is the vector of actuator torques and/or forces, H £ R nXn is the robot inertia matrix, P £ W is the 
end-effector/env.ronment contact force and/or moment, and V ee ,Vf,G £ R n ^present the torque vector, due to Coriolis 

dcentnpedal acceleration, friction, and gravity, respectively. Alternatively, the robot dynamic model can be expressed in 
cartesian- space as [e.g., 16J 


X 


’M*y 

z 




F = (JH~ 1 J T )~ 1 [y - j9] + (JH-'jTy'jH-'lV" + V f + G] + P* (36) 

whCTC F £ RF 1 is the generalized force vector corresponding to the generalized coordinate y, and P* = \ 0 T I P T ] T G R m 
with the zero denoting an /-dimensional zero vector. 

to ^“‘ <U1 '* P * CC position/force control problem for the redundant robot described in (l)-(3) may be considered 

1. ) Cartesian position /force trajectory tracking: 

compute the Cartesian control input F = [ Fj \ Fj f £ R m required to track the desired m-dirnensional 

position/force trajectory, where F p £ R l is the position control input that tracks the desired end-effector position 

trajectory X d £ R and Fj E R 1 is the force control input that track, the desired end-effector/environment 
contact force trajectory E ffl 

2. ) F — ► T mapping: 

compute the joint torque vector T E R n required to realize F while simultaneously accomplishing some desired 
Jcinematic and/or dynamic performance objective. 

Each of the steps will now be considered individually. 

2.2 Cartesian Position /Force Trajectory Tracking 

dime^W / dV he < ^ a £ esian position/force trajectory tracking problem is nonredundant since F p and X d are both of 

^Tcontro/i^ft^ f^ i Pd ^ m ? 8i ° n J - ThU5 m “ y different control “rategies could be improvised to compute 

£ J. ° . th *‘ WOuld en8Ur ' that the dynamics (3b) tracks the desired end-effector position/force trajectory. Here 

the adaptive Cartesian-space position/force controller recently developed by Seraji [22] for nonredundant robots will be adopted 
aject ° ry trackin « This control scheme was derived from an improved Model Reference Adaptive Control 
(MRAC) method, and requires no knowledge of the robot dynamic model or parameter values for the robot, the payload, or 

for Cn ™° nme ' 1 * 8 “ | re81 f lt - the controller is robust to both model and parameter uncertainties, and is computationally fast 

for on-line control applications with modest computing power. 

The control algorithm computes the position control input Fp as follows: 

F p = d p (t) -f K P p(t)Ep + K vp (t)Ep + C(t)x d + B(t)x d + A(t)x d (4) 

l? T*, h %l P °°[ tion t ( ack i n 8 error, and d p E R 1 and K pp , K vp ,C,B,A £ R ,x < are controller gains which 
are updated adaptively. The adaptation laws for these gains are provided in [22] and are not repeated here. Note that the 
control input t p is computed entirely based on the observed performance of the manipulator. 
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The control scheme computes the force control input F j using the following algorithm: 


Fj = dj(t) + Ki(t) [ Ejdt + K pJ (t)Ej - K vJ (t)i + Pd 

Jo 


( 5 ) 


where E, = Pd~P » the force tracking error, and dj <E W and Kj , K p j , K v f € R 1 * 1 are controUer gams which are 
updated 'adaptively. Again, the adaptation laws for these gains are provided in [22] and are not repeated here. Note that the 
control input Fj is computed entirely based on the observed performance of the robot. . r , ■ , , 

Finally, the position control input F p computed in (4) and the force control input F, computed in (5) are combined to 

form the Cartesian control input F ' 


F = [FJ | Fj} 1 


( 6 ) 


2.3 Redundancy Resolution Through Construction of F — ► T Map 

Observe that the control input F cannot physically be applied to the robot end-effector; therefore this d^.red control 
input must be mapped to an actuator torque vector T. The F — T mapping problem is underdetemuned since t € «« d 
T € R n With m < n, so that it is at this stage of the control problem that the robot redundancy may be utilized to improve 

the robot’s performance. . , , T ^ F 

The problem of constructing an appropriate F — ► T map may be formulated in terms o inver ing e o 

map, which is unique even for redundant robots. The T -*• F map may be shown to be [13,16] 


F = {JH~ l J T ) JH~ l T=M(0)T 


( 7 ) 


where it is easily verified that M E R mXn ■ Inversion of the T — F map (7) may be achieved in two ways: 

1.1 “direct" inversion of (7) using the theory of generalized inverses [23] ...... 

2.) “indirect” inversion of (7) by first augmenting both M and F with r = n - 171 additional rows and then inver ing 

the resulting fully determined system by standard methods . , . . 

Each of these approaches is now briefly summarized. Additional detail, concerning each inversion method are provided in 

Sections 3 and 4 of this paper, and also in [13,24]. ... , 

The direct approach to inverting (7) has proven useful for realizing dynamic performance objectives, primarily because 
inverting (7) using generalized inverse theory readily permits optimization of objective functions involving joint torque 1 and 

joint accelerations 9. For example, the F — * T map which minimizes the norm of the joint torque vector ||T|| = (T T T) , 
subject to the constraint (7), may be easily derived using generalized inverses: 


T = H~ l J T {J H~ 2 J t ) 1 JH~ 1 J t F 


( 8 ) 


The indirect approach to inverting (7) has been utilized principally for realizing kinematic performance objectives. While the 
idea of augmenting M and F with r additional rows to obtain a fully determined system is conceptually simple, selecting these 
additional rows in such a way that some desired performance objective is realized is more difficult. The process of augmenting 

M in an appropriate manner can be simplified somewhat by choosing to augment J instead. Let J a — [J I J c ] ^ 72 

be the matrix that results from augmenting J with J c £ R rxn . Then, provided J a is nonsingular, replacing J with J a in (7) 
allows this T — ► F map to be inverted by standard methods, yielding 


t-j t f + jTf c 


( 9 ) 


where F e g 72 r is an appropriately chosen vector used to augment F. One method of specifying the terms J c and F c in (9) 
has been derived by Seraji [17], and is summarized in Section 4 of this paper. 

3. OPTIMIZATION OF THE DYNAMIC RESPONSE OF THE ROBOT 

One of the advantages of a redundant robot is the potential to use the “extra” DOF to improve the robot’s dynamic 
response [13,14,25]. One approach to achieving this improved performance is to devise a strategy for allocating motion among 
the robot joints in such a way that the desired end-effector motion is tracked with minimum actuator torque. This strategy 
will increase the bandwidth of the robot for a given set of actuator torque limits, which in turn will lead to improved tracking 
of both position and force trajectories [26]. 

Local minimization of the (norm of the) joint torque vector required to provide the desired Cartesian control input t is 
achieved in Section 2.3 using the direct approach to inverting the T — ► F map (7), and the result is given in (8). However, it 
has been found in previous investigations that local (in time) minimization of joint torques often leads to trajectories that are 
globally unstable [9,27]; thus implementation of the F — * T map (8) may be undesirable. 

An alternative approach to reducing joint torque requirements is to consider the following constrained optimization problem: 


minimize 


/ 1 \e T Hedt 

Jo 2 


subject to the constraint y — f(9) 


(10) 
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C ° rnpletion timeN ot e that (10) is a global optimisation problem, and therefore it. solution should 
™l^Hineri characteristics of a globally optimal solution, such as trajectory stability. Note also that minimising total 

kinetic energy integrated over the entire trajectory, subject to the constraint of desired end-efTector motion, should lead 
o a uniform reduction in joint torques and a corresponding uniform increa« in dynamic response. The optimisation problem 
(10) may be analysed using the calculus of variations [28], First, the intermediate function L(0, 0, X) £ R is constructed: 


L=±6 T H0 + \ T (t)[y-f(0)] 


where X £ R m ia the Lagrange multiplier vector. The necessary conditions on (11) for optimality of (10) are 


— = 0 — - - 

d\ ’ 80 dt 90 


Substituting (11) into the necessary conditions (12) yields, after some simplification, 


y-J0-j0 = o , H0 + HO- J T X- \d(0 T H0)/d0 = 0 


The equations (13) may be solved for 6 [13]: 


(ii) 


( 12 ) 


(13) 


0 = - JO) - [I n - H* 1 J T (J H~ l J T )~ l J]H~ l V ce (14) 

where I„ £ R n * n j* the identity matrix. Note that the solution (14) to the problem (10) has been obtained, independently, 
by Kazerounjan and Wang [29]. 

Expressing the necessary condition for optimising (10) as an F — T map may be achieved by substituting the joint-space 
dynamic model (3a) and the Cartesian-space dynamic model (3b) into the necessary condition (14), and simplifying the result: 

T = J T F + [/„ - J t (JH- 1 J t )~ 1 JH- 1 ](V j +G) (15) 

A close approximation to the global minimum kinetic energy F —* T map (15) may be obtained as follows. Observe that 
the operator [/„ - J T (JH~ 1 J T ) J H~ l ) projects the vector Vf + G into the null-space of J H ~ 1 (this may be verified 

by pre-multiplying the projection [/„ - J T (JH~' J^f 1 Vj + G) by JH~' and noting that the result is the sero 

7^-1 ** fACt ’ U 18 * h ° Wn m 24 tHat thi * ° pcr&tor P r °j cct « vector Vf + G onto only a portion of the null-space of 

J H , and that typically the resulting projection is small compared to the term J T F . These results imply that the F — ► T 
map 

T=J t F (16) 

T map. Note that the map (16) is computationally 


is a close approximation to the global minimum kinetic energy F 
efficient and requires no knowledge of the robot dynamic model. 

In summary, it is hypothesized that utilizing the robot redundancy to construct the F — T map which minimizes robot 
kinetic energy integrated over the trajectory, subject to the constraint of desired end-effector motion, will lead to a uniform 
reduction in joint torques and a corresponding uniform increase in dynamic response. Moreover, the resulting robot trajectory 
should be stable because of the globally optimal nature of this F — ► T map. In view of the fact that the F — ► T map (16) is 
a close approximation to the minimum kinetic energy map (15), and possesses the desirable features of computational efficiency 
and robustness to dynamic model uncertainty, it is proposed that the map (16) be employed in the control algorithm. The 

performance of the control scheme (4)-(6) together with the F -> T map (16) is examined through computer simulation in 
oection 5. 

4. CONSIDERATION OF KINEMATIC PERFORMANCE OBJECTIVES 

In this Section, the control algorithm (4)-(6),(16) is modified so that the robot redundancy is used to simultaneously 
improve the robot’s dynamic response and realize any specified kinematic performance objective. 

It is shown in [18] that a redundant robot may be controlled to track a desired end-effector position/force trajectory and 
simultaneously satisfy an r-dimensional kinematic constraint of the form 


rP(t) = g(0) ( 17 ) 

where g : R n — > R r and Ip E R r defines the evolution of g. The control algorithm developed to achieve this desired 
performance computes the Cartesian control input F using (4)- (6), and then maps this control input to the robot actuator 
torque 1 as follows: 

T = J T F + p(dg/dO) T F e (18) 
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where dg/30 G R rxn i. the constraint Jacobian, p G R + was implicitly defined asp - 1 in [18], and F e € RT if ^the 
constraint control input required to track the desired evolution of (17), denoted a. *|(i). The constramt control mput F c >s 

compute! _ dp (<) + K pp (t)E c + K vp (t)E c + C(t)ip d + ( 19 ) 

where E c = ^d ~ 4> “ the constraint tracking error, and the adaptive gains d p G R r and K pp , K vp , C,B, A £ R are 

updated based on the constraint tracking error E c . . ,, , , 

Observe that setting p = 0 in (18) reduces that map to the (approximate) minimum kinetic energy t -* l map (lb), 
while setting p = 1 in (18) causes the robot redundancy to be used to closely track the kinematic constraint (17). Thus the 
map (18) may be viewed as a modification of the map (16) to include the potential to satisfy kinematic constraints and the 
parameter p may be used to specify the relative importance of dynamic response and constraint tracking accuracy. In typic 
applications (e.g , obstacle avoidance, joint limit avoidance), the constraint (17) need not be tracked with the same -curacy 
as the end-effector task. Then p can be chosen small, and adequate constraint tracking and improved dynamic response can 
be achieved simultaneously. The selection of an appropriate value for p and the effect of this choice on the performance 

robot is quantified through example in Section 5. a . 

The control algorithm (4)-(6), (17)-(19) provides a method for controlling a redundant robot so that end- effect or p 
tion/force trajectory tracking and general kinematic constraint satisfaction are achieved simultaneously. This control scheme 
can be extended to include utilizing the redundancy to optimize general kinematic performance objectives. Let the general 
kinematic performance optimization problem be formulated as 


maximize G(^) subject to the constraint y — /(^) ' ' 

where G : R n —■ R may be constructed to represent a measure of any desired kinematic performance objective. The solution 
to (20) can be obtained using Lagrange multipliers. Let the augmented scalar objective function G (ff, A) be defined as 

G m (e,X) = G(0) + X T [y-f(O)] (21) 

where A G R m is the vector of Lagrange multipliers. The necessary conditions for optimality of (20) may be written using 
( 21 ): 


8G*/d A = 0 => y = f(0) 

dG'/de = o => dG/de = j T a (22) 

From (22), it is seen that a necessary condition for optimality of (20) is that 8G/dO G R{J T ). This requirement may be 
written concisely as (nn\ 

AdG/dO = 0 (23) 

where A G R r * n is any matrix whose rows form a basis for the null-space of J. This result is a direct consequence of the fact 
that the row-space and the null-space of any matrix are orthogonal complements. Note that (23) can alternatively be obtained 
using gradient projection optimization theory [30], and that this approach was first proposed for redundancy resolution by 
Baillieul in his “extended Jacobian” method [4]. When -G(9) is convex, the condition (23) is both necessary and sufficient to 
solve (20). This is of interest because in robotics applications it is usually possible to construct G{9) so that —G(V) is convex. 

Observe that the optimality condition (23) is an r- dimensional kinematic equality constraint of the form (17) with g — 
AdG/d9 and 1p d (t) - 0. Therefore the control law (4)-(6), (17)-(19) can be used for simultaneous end-effector trajectory 
tracking and optimization of any desired kinematic objective function G(9). Indeed, assuming that G (9) is defined (and 
differentiable), specification of the kinematic equality constraint that is to be tracked to achieve this optimization requires oidy 
that an appropriate A matrix be constructed and that the calculations specified in (23) be performed. The matrix A may be 
constructed in several ways; one formulation for A is [13] 

A = [-JJ{Jr 1 ) T I Ir] (24) 

where J, G R mxm and J 2 G R m * r axe the partitions of J defined by J - [J\ \ J 2 ]• The validity of the construction 

(24) for A may be verified by observing that AJ T = 0 and that the row rank of /I is r for all 0 due to the presence of the I r 

partition in (24). , 

Summarizing, the control algorithm (4)-(6), (17)-(19) can be extended to include utilizing the redundancy to solve the 

kinematic performance optimization problem (20) by setting g = AdG/89 and rj> d = 0, where A E R is given in (24). 
The comments made previously concerning the role of the parameter p in the control law apply here as well, of course. The 
use of the control algorithm (4)-(6), (17)-(19) for the case in which the kinematic performance objective is the optimization of 
a kinematic objective function is illustrated in Section 5. 
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5. SIMULATION RESULTS 

5.1 Overview of Computer Simulation Study 

The Cartesian-space position/force control scheme for redundant robots given in ( 4 )-( 6 ), (17)-(19) is now applied to a 
direct-drive four-link planar robot in two computer simulation examples. The results presented here are samples selected from 
a comprehensive computer simulation study which was carried out to test the performance of the proposed controller. Note 
that the results given here are selected because they are typical of the larger study, and not because they represent the best 
performance obtainable with the proposed control law. 

^Consider the four-link robot in a horizontal plane shown in Figure 1 . The robot parameters are link lengths /. = /, = 
l 3 - 7nn xi m ’ llrJ ‘ mA88e8 mi = m 2 = m 3 = m 4 = 10.0 kg, and joint viscous friction coefficients d = C 2 = C 3 = 
C 4 _ 1 U.U Nt m-.ec; the link inertias are modeled by thin uniform rods. The frictionless reaction surface is located parallel to 
the *-ax.s at 2 - 0.0 and has a Stiffness of 10 Nt/m. Note that in this example the base frame is chosen as the constraint 
frame, so that the position subspace and the force subspace are each of dimension one and correspond to the * and 2 axes 
respectively. The robot dynamic model which relates joint torques T G R* and joint angles 9 G R 4 is given by 


T = H ( 0)9 + v cc (9, 9) + Vj(9) + jfp 


(25) 


In the dynamic model (25) the numerical value, for the inertia matrix H € R 4x4 , Coriolis and centrifugal torque vector 
, cc 6 K mid viscous friction torque vector V, 6 R 4 may be found in [19). Note that the gravity vector is orthogonal to the 
plane of motion of the robot, so that no gravity torques appear in (25). It must be emphasized that the dynamic model (25) is 
used only to simulate the robot behavior and is not used in the control law formulation. 

In the simulation study, the performance of the control scheme ( 4 )-( 6 ), (17)-(19) is evaluated through comparison with a 

commonly proposed approach to redundancy resolution, the tnerlta-weighled pseudoinverse approach [ 9 ], Specifically the 

performance of the proposed controller is compared with the performance of a controller which resolves the robot redundancy 
as follows: J 


9=H- l J T (JH- l J T )-\y-j9) (26) 

To aUow a meaningful comparison to be made between the control law (4)-(6), (17)-(19) and the redundancy resolution scheme 
(26), the inverse kinematics algorithm (26) must be implemented as an equivalent F — ► T map. This equivalent F — ► T map 
may be derived using the same approach taken when rewriting the inverse kinematics algorithm (14) as the equivalent F — T 
map (15), and yields the following result: 


T = j t f + [/„ - 'jry'jH-'KV" + V S ) 


(27) 


Th e F —*T map 27) may be combined with the control scheme (4)-(6) to yield a pseudoinverse-based position/force controller; 
this ccmtroUer reso ves the robot redundancy exactly as prescribed in the inverse kinematics algorithm (26). Note that in deriving 
w 1 maP ( ) U " *»»umed that G = 0, since this is the case in the simulation study 

lhe j di8CUMi i ° n of two computer simulation examples. Throughout this discussion, the control law (4)-(6), 
( 17 )-( 19 ) will be referred to as the proposed controller while the control scheme given by ( 4 )-( 6 ) together with the F -1 T 

IS meter, the unit of angle is radian, the unit of force is Newton, and the unit of time is second. 

5.2 Simulation 1 

The task requirement, for this simulation are to have the robot end-effector track a straight-line position/constant force 
traieclo™ i7w/T-*9n ^ redundancy to improve the dynamic response of the robot. The desired end-effector position 
Th A l-A a IT -0 + A 0 A 0 COSU)t, for t c [0 ,t/w] and for different values of the trajectory parameters A a and W. 
The des!red end-effector /environment contact force is P d (t) = 10.0, for t C [0, x/u]. The initial configuration of the robot 

is 0(0) [ jr/3 — 2t/3 2t/3 — 2t/3 ] , and the robot is initially at rest. 

1 ? he P ro P 09ed . controller and the WP controller each accomplishes the required position/force trajectory tracking by em- 
ploying the Cartesian control algorithm (4)-(6). The desired position trajectory is tracked using a scalar version of the position 
control algorithm (4) and the desired force trajectory is tracked using a scalar version of the force controUer (5). The position 
control input P p and force control input Fj are combined to form F as prescribed in (6). 

t»J l *T I1 1 T? Cy reSOlUti .° n is * chieved w ^ en ”“PPin« the Cartesian control input F (computed in (4)-(6)) to joint actuator 
torque T. The map used ,n the proposed controller for increaring the robot's dynamic response in a stable manner is given 

aniLor7»» h F Z T ThC F ~ > i- T i maP u U *! d ^ thC WP controUeri9 « iven in ( 27 )- Th « algorithm (4)-(6) together with the 
PP f , nU4p 19 “PP^ed to the dynamic model (25) through computer simulation on a SUN 3/50 computer with a 

sampling period of one millisecond. 

In the first simulation, the end-effector trajectory parameters are assigned the values A„ = 0.5 and U = 0.25. The results 
of the simulation are shown in Figures 2a-2c, and indicate that both controllers perform well. This is as expected, because the 
required end-effector motion is slow and of moderate length. 

r 4 I “i h n n fl eXt 9imul “ ti ° n ' th< ^nd-effector trajectory is made both longer and faster by choosing trajectory parameter values 
ot y± 0 - U.S andW - 1^0. The results of the simulation are given in Figures 2d and 2e, and show that the WP controUer 
requires much larger torques than the proposed controUer, and yet achieves poorer tracking accuracy. 
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£Ei2-ii— ... -..- «■— — ... — — - - 

“manipulability measure” W. R n - R + , defined by Yoshikaw. as follow. [1]: 


w(0) = ( det[J J T ]) 


1/2 


( 28 ) 


Briefly, it 1m, been propo^d by Yoshikawa [1] and other, that utilizing robot redundancy to maximize manipulability may be 

ploying the Cartesian control algorithm (4) ( ), rp rp. ^ j n ^ proposed controller 

in therc controUers when mapping the Cartesian control input F to joint torque 2 P _ ^ ^ ft) = 0, 

where the matrix j4 is constructed as in (24). P . \ ' . a i A 0 f how effectively this proposed 

response and increasing manipulability, i. cho«n (heunstically) a® P - 0 . 1 . A LtroHnput F 

“-tssSS; rnSiMe, m« -*b a- «-**-/ - r 7? i “ pp ^‘ o .‘ 1 r u b i,t n r;rS! 

= °. .. 

configuration be the maximum manipulability configuration corresponding to the initial end-effector position [ ]. 

of obtaining the optimal initial configuration 0* (0) is to integrate the differential equation 

e=[I-J T {JJ T )- l J]dw/d9 ( 29 ) 

until it reache, equilibrium. The .tarting point for the integration may be any configuration 0 which P^ ‘h« ^-trUh^the 
the desired initial position, and the equilibrium configuration of (29) i. the opt,mJconfi^t.on0.Usmg thi. *or , 

optimal initial configuration of the robot is obtained as 0(0) = [ 1 .697202 - 1.570791 -0.252815 - 1.570791] 

“ZZSZlrJ ‘Z.’ZSZO ; « 1™,. F*~ 3.3d. Th- T-a. indict, ,h„ th. WP -£ 

larger torque, than the proposed controUer, and exhibit, poorer tracking accuracy _ 

manipulability is very nearly maximum over the entire trajectory. Thu. the propose con ro er acc entire trajectory 

trajectory and successfully increases both the robot’s dynamic response and man.pulab.hty measure over the entire trajectory. 

6 " This'paper presents a Cartesian-space position/force control scheme for redundant robots The proposed control strategy 
i. to partition the control problem into a nonredundant position/force trajectory tracking problem and a 

problem between Carte.ian control input F and robot actuator torque T. The underdetemuned nat^^heF P 

i. exploited to allow the redundancy to be effectively utilized directly in Cartesian-space. Computer 

given for a four DOF planar redundant robot under the control of the proposed algorithm, and demonstrate that accmate 
position/force trajectory tracking and effective utilization of redundancy can be achieved simultaneously with the controller. 
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